APPENDIX A 



% BEGINNING OF PSEUDO CODE 

5 % compute scale factor A, and time constants a, b from physical system 

% parameters 

A = Vmax * Kt/ (Re * Rm + Kt * Kb) * 1 * k; 

10 pi = 1/Jm/Ie * (-Ie * Rm - Re * Jm + sqrt(Ie A 2 * Rm A 2 - 2 * Re * Rm * Ie * Jm 
+ Re A 2 * Jm A 2 - 4 * Kt * Kb * Ie * Jm)) / 2; 
p2 = l/Jm/Ie*("Ie*Rm-Re* Jm - sqrt(Ie A 2 * Rm A 2 - 2 * Re * Rm * Ie * Jm 
+ Re A 2 * Jm A 2 - 4 * Kt * Kb * Ie * Jm)) / 2; 

15 a = max(-pl,-p2) 

b = min(-pl,-p2) 

% make initial guesses for step durations 

20 etl = 1; 

et2 = .005; 
et3 = 1; 



25 



% set maximum iteration count 
Nmax= 1000; 



forj = l:Nmax 

% save old values of step time intervals 
30 et3old = et3; 
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et2old = et2; 
etlold = etl; 



% iterate for switch times using fixed voltage level Vmax 

5 

et3 - -log(L0 / 2.0 - exp(-etl * a) / 2 + exp(-et2 * a)) / a; 

et2 - 1/b * log(2.0) + 3 * et3 - 1/b * log(2 * exp(l/A * b * X) * exp(et3 
* b) - sqrt( 4.0) * sqrt(exp(l/A * b * X)) * exp(et3 * b) * 
sqrt(exp(l/A * b * X)+exp(et3 * b) A 2 - 2 * exp(et3 * b))); 
10 etl = - (-2 * A * et2 + 2 * A * et3 - X) / A; 

if norm([et3old - et3 et2old - et2 etlold - etl], inf) <= eps * 2 
break 

end 

15 ifj=Nmax 

error(['error - failure to converge after num2str(Nmax) ? t 
iterations']) 

end 
end 

20 

% round up pulse duration to nearest sample interval, 

% convert to intervals between steps to make sure that voltage 

% requirements will not increase (beyond Vmax). 

25 dtl=ceil((etl - et2) / dt) * dt; 

dt2=ceil((et2 - et3) / dt) * dt; 
dt3=eeil((et3) / dt) * dt; 

etl23 = [etl,et2,et3] 
30 % convert back to total step duration. 
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etl =dtl +dt2 + dt3; 
et2 = dt2 + dt3; 
et3 = dt3; 



% In the following, the original constraints equations involving XF1, XF2, 
% and XF3 have been modified to include a variable voltage level applied 

at 

% each step (instead of the fixed maximum (+/-) Vmax). 



10 % The original equations for XF1 , XF2, and XF3 follow: 

% XFi(W = VoFi(t te „ d - to) - 2VoF 1 (t e „d - ti) + 2V 0 Fi(te n d - 1 2 ) 
% XF 2 (t end )-VoF2(ttend-to)-2VoF 2 (t en d-t 1 ) + 2VoFi(t ell d-t2) 

% XF 3 (te„ d ) = VoF 3 (t tend - to) - 2VoF 2 (te a d - t0 + 2V 0 F 1 (tend - t 2 ) 



15 % And the modified equation including adjustable relative levels of 

voltage 

%L1, L2andL3 are: 

% XFi(te„d) = LiV 0 Fi(ttend " to) - L 2 V 0 Fi(te„d - ti) + LsVoFiOend - t 2 ) 

% XF 2 (t end ) = LiV 0 F 2 (t te „ d - 1 0 ) - L 2 V 0 F 2 (te„d - ti) + L 3 VoFi(t e „d - 1 2 ) 
20 % XF 3 (te„d) = LiV 0 F 3 (t tend - to) - L 2 V 0 F 2 (t eil d - ti) + L 3 V 0 Fi(t e „d - 1 2 ) 



% And the corresponding constraint equations are: 
% XFi(tend) = Finalpos 
% XF 2 (t end ) = 0 
25 % XF 3 (t e „ d ) = 0 



% Where all of the times indicated have discrete values, e.g. 
corresponding to 

% the controller update rate. 

30 
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% It should be noted that after the digital switch times are fixed, the 
constraint 

% equations derived from the equations above form a linear set of 
equations in 

5 % the unknown relative voltage levels LI, L2 and L3 and any standard 

linear 

% method can be used to solve for the relative voltage levels. In the 
equations 

% for (LI, L2 and L3) that follow, the solution was obtained by algebraic 
1 0 % means (and are not particularly compact.) 

% compute new relative voltage step levels 
% LI, L2 and L3 are nominally assigned to "1", "-2" and "+2", 
respectively 

15 si = X * (exp(-et3 * b) * exp(-et2 * a) + exp(-et3 * a) + exp(-et2 *b ) -exp(-et2 
*b) * exp(-et3 * a) - exp(-et2 * a) - exp(-et3 *b )); 
s2 = 1 / (et2 * exp(-etl * b) * exp(-et3 * a) + exp(-et2 * b) * et3 * 

exp(-etl * a)- et2 * exp(-et3 * a) - et2 * exp(-etl * b) -et3 * 
exp(-etl * a) - exp(-et2 * b) * et3+exp(-et3 * b) * etl * exp(-et2 * 
20 a) + exp(-et3 * a) * etl + exp(-et2 * b) * etl - exp(-et2 * b) * etl * 

exp(-et3 * a) - et3 * exp(-etl * b) * exp(-et2 * a) - exp(-et2 * a) * 
etl - exp(-et3 * b) * etl - exp(-et3 * b) * et2 * exp(-etl * a) + et3 * 

exp(-etl * b) + et2 * exp(-etl * a) + exp(-et3 * b) * et2 + et3 * 
exp(-et2 * a)) / A; 

25 

LI = si * s2; 



si = 1 / (et2 * exp(-etl * b) * exp(-et3 * a) + exp(-et2 * b) * et3 * 

exp(-etl * a) - et2 * exp(-et3 * a) - et2 * exp(-etl * b) - et3 * 
30 exp(-etl * a) - exp(-et2 * b) * et3 + exp(-et3 * b) * etl * 
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exp(-et2 * a) + exp(-et3 * a) * etl+exp(-et2 * b) * etl - 
exp(-et2 * b) * etl * exp(-et3 * a) - et3 * exp(-etl * b) * 
exp(-et2 * a) - exp(-et2 * a) * etl - exp(-et3 * b) * etl - exp(-et3 * 
b) * et2 * exp(-etl * a) + et3 * exp(-etl * b) + et2 * exp(-etl * a) + 
5 exp(-et3 *b ) * et2 + et3 * exp(-et2 * a)) * X; 

s2 = (exp(-et2 * b) * exp(-etl * a) - exp(-etl * a) - exp(-et2 * b) - 

exp(-etl * b) * exp(-et2 * a) + exp(-etl * b) + exp(-et2 * a)) / A; 
L3 = sl*s2; 

10 sl = exp(-etl * a) - exp(-et3 * a) + exp(-et3 * b) - exp(-etl * b) - 

exp(-et3 * b) * exp(-etl * a) + exp(-etl * b) * exp(-et3 * a); 
s2 = X / (et2 * exp(-etl * b) * exp(-et3 * a) + exp(-et2 * b) * et3 * 

exp(-etl * a) - et2 * exp(-et3 * a) - et2 * exp(-etl * b) - et3 * 
exp(-etl * a) - exp(-et2 * b) * et3 + exp(-et3 * b) * etl * exp(-et2 * 
15 a) + exp(-et3 * a) * etl + exp(-et2 * b) * etl - exp(-et2 * b) * etl * exp(- 

et3 * a) - et3 * exp(-etl * b) * exp(-et2 *a) - exp(-et2 * a) * etl-exp(-et3 * 
b) * etl - exp(-et3 * b) * et2 * exp(-etl * a) + et3 * 

exp(-etl * b) + et2 * exp(-etl * a) + exp(-et3 * b) * et2 + et3 * 
exp(-et2 * a)) / A; 

20 

L2 = si * s2; 

% convert accumulated voltage steps to sequential voltage level 
VI = Vmax * (LI); 
25 V2 = Vmax*(Ll+L2); 

V3 = Vmax * (LI + L2 + L3); 

% END OF PSEUDO CODE 
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APPENDIX B 



AREA .. SUM(I,A(I)) =E= 0; 

VELOCITY(VINDX) .. VEL(VINDX) =E= VSCALE * 
SUM(I$(ORD(I) LE ORD(VINDX)), A(I)); 

POSITION .. SUM(I,VEL(I)) =E= FINALPOS * SCALEFACT; 
VLIMITP(I) .. SUM(VINDX$(ORD(VINDX) LE ORD(I)),A(I- 
(ORD(VINDX)+l))*(VOLTS(VINDX)+KBACK*VSCALE)) 

=L= VOLTLIM; 

VLIMITN(I) .. SUM(VINDX$(ORD(VINDX) LE ORD(I)), A(I- 
(ORD(VINDX)+l))*(VOLTS(VINDX)+KBACK*VSCALE)) 

=G= -VOLTLIM 

% A(I) are the current commands at time T(I) spaced equally at time DT. 
% VOLTS(VINDX) is a table of voltages representing the unit pulse 
response to 

% a unit output in current command. VOLTLIM is the voltage limit at 
saturation. 
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APPENDIX C 

GOALPOS .. SUM(I,A(I)*MODELAA*DT) =E=FINALPOS; 

MODEl(ILAST) .. SUM(I,-A(I)*MODELAA*MODELb/ (MODELb- 
5 MODELa)*(EXP(-MODELa*(T(ILAST)+DT-T(I))) 

-EXP(-MODELa*(T(ILAST)-T(I))))) =E= 0.0; 

MODE2(ILAST) .. SUM(I,A(I)*MODELAA*MODELa/(MODELb- 

MODELa)*(EXP(-MODELb*(T(ILAST)+DT-T(I))) 

-EXP(-MODELb*(T(ILAST)-T(I))))) =E= 0.0; 
10 DERIV1(J) .. 1000.0*SUM(I,A(I)*T(I)*EXP(ZETA(J)*W(J)*T(I))* 

SIN(WD(J)*T(I))) =E= 0.0 ; 

DERIV2(J) .. 1000.0*SUM(I,A(I)*T(I)*EXP(ZETA(J)*W(J)*T(I))* 
COS(WD(J)*T(I))) =E= 0.0 ; 

1 5 % MODELAA is the mechanical gain of the system, MODELb, and MODELa 

% are the two time constants of the system in radians. One time constant is 
% associated with the L/R rise time of the motor inductance and the other is 
% the mechanical time constant of the rigid system. The A(I) are the voltages % 
which need to be determined. The T(I) are the times for each of the A(I). 

20 % DT is the time spacing of the outputs. W(J) are the undamped flexible 

% modes, WD(J) are the damped flexible modes (in radians/s). 
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